METHOD AND DEVICE FOR MEASURING DIRECTIONAL, AND 

COMPUTER PROGRAM 



BACKGROUND OF THE INVENTION 
5 1 ) Field of the Invention 

The present invention relates to a technology for measuring a 
directional (i.e., direction and position) of an object in a 
three-dimensional space. 

10 2) Description of the Related Art 

The directional measuring devices, also called the electronic 
compasses, detect geomagnetic forces in each of a plurality of 
directions using a magnetic sensor corresponding to each direction and 
calculate a direction to be observed, i.e., a directional of an observation 

15 axis from the result of detection. Such directional measuring devices 
are used in cell phones, portable information terminals such as 
personal digital assistants (PDAs), wrist watches, car navigation 
systems such as vehicle compasses, attitude detectors for airplanes, 
directional measuring devices for visually impaired persons, and even 

20 game machines. 

Particularly, position information service for the portable 
information terminals has been started recently. In the position 
information service, a present position of a portable information terminal 
is displayed on a screen of the portable information terminal along with 

25 a map of a surrounding area so that the user of the portable information 



Li 



terminal can locate his/her present position. By thus combining the 
directional measuring device with the portable information terminal on 
which the position information service can be enjoyed, it becomes 
possible for a user to recognize to which direction he/she is facing or to 
5 which direction he/she is going. The information providing service that 
employs the position information service and the directional measuring 
device is expected to create a lot of new business opportunities in 
various industrial fields in near future, and the other hand, the users are 
privileged by getting useful information. However, the spreading of the 

10 information providing service requires the precision of the directional 
measuring device to be increased from what it is at present. 

The directional measuring devices have a drawback that an 
azimuth cannot be precisely measured if the directional measuring 
devices are in tilted posture. The users of the directional measuring 

15 devices may use them or hold them in various ways, and it is quite 

possible that a user holds his/her directional measuring device in such 
a manner that a magnetic sensor in the directional measuring device is 
in a tilted posture. If the magnetic sensor is in a tilted posture, 
although the observation axes indicate the identical azimuth, an output 

20 of the magnetic sensor changes according to an amount of the tilt, and 
therefore, an error may occur in calculation of the azimuths. 

For example, if a biaxial magnetic sensor, which corresponds to 
an x-axis and a y-axis orthogonal to the x-axis, is rotated around a 
vertical axis so that the x-axis and the y-axis tilt by a certain tilt angle 

25 with respect to the x-y plane, the output of the biaxial magnetic sensor 



cannot be expressed by simple sine waveform and cosine waveform but 
can only be expressed with complex waveforms depending on factors 
such as a dip of the tilt angle. Consequently, an azimuth 0 (obtained 
with 9 = arctan (y/x)) calculated from the output of the biaxial magnetic 
5 sensor is erroneous. 

Japanese Patent Application Laid Open No. 2002-196055 (see 
page 5, equation 2) discloses an omnidirectional magnetic sensor 
capable of automatically correcting a tilt and precisely calculating the 
direction. Fig. 10 is a flowchart of a process procedure disclosed in 

10 the above-mentioned literature. As shown in this flowchart, three 
magnetic vectors corresponding to three dimensions (hereinafter, 
"three-dimensional magnetic vectors' 1 ) are acquired from the output of 
the magnetic sensor (step S1001). A pitch angle and a roll angle of 
the body of the magnetic sensor are acquired from the output of a tilt 

15 sensor (step S1002). Coordinate transformation is performed twice to 
the coordinates of the three-dimensional magnetic vectors using the 
pitch angle and the roll angle to calculate a magnetic vector of a 
horizontal magnetic field component (step S1003). An azimuth is 
calculated from the magnetic vector of the horizontal magnetic field 

20 component (step S1004). 

More specifically, the omnidirectional magnetic sensor employs 
a method of rotating the geomagnetic vector to the horizontal magnetic 
field component using the rotational transformation. In the rotational 
transformation, a product of a rotation matrix used to rotate the body of 

25 the omnidirectional magnetic sensor around the X-axis and a rotation 



matrix used to rotate the body around the Y-axis in an absolute 
coordinate system is used. The absolute coordinate system includes 
the X-axis that points towards the magnetic north on a horizontal plane, 
the Y-axis that is orthogonal to the X-axis on the horizontal plane, and 
5 the Z-axis that is orthogonal to the horizontal plane. A observation 
coordinate system that includes an x-axis that is the direction towards 
which the body points, a y-axis that is orthogonal to the x-axis, and a 
z-axis that is orthogonal to the x-axis and the xy plane. The rotational 
transformation is performed with respect to the absolute coordinate 

10 system. In other words, the rotation matrix corresponding to the X-axis 
is used to rotate the y-axis in the horizontal plane, and the rotation 
matrix corresponding to the Y-axis is used to rotate the x-axis in the 
horizontal plane. The conventional method of directional 
measurement is explained in further detail below using specific 

15 equations. An observation coordinate system, which corresponds to 
an x-axis, a y-axis, and a z-axis, is a coordinate system obtained by 
rotating an absolute coordinate system, which corresponds to an X-axis, 
a Y-axis, and a Z-axis, around the Z-axis by angle 0 (azimuth), around 
the Y-axis by angle (3 counterclockwise, and around X-axis by angle a 

20 counterclockwise. The x-axis is an observation axis. A rotation 

matrix corresponding to a rotation around the Z-axis is assumed to be 
Zr, a rotation matrix corresponding to a rotation around the Y-axis is 
assumed to be Yr, and a rotation matrix corresponding to a rotation 
around the X-axis is assumed to be Xr. 

25 Geomagnetic direction vectors (x H , yH, zh) in the observation 

4 



coordinate system can be expressed in a form obtained by converting 
geomagnetic direction vectors (X, Y, Z) in the absolute coordinate 
system using inverse matrixes of the rotation matrixes Zr, Yr, and Xr. 
If output values of the azimuth 9 in the horizontal plane in the directions 
5 of the axes are taken as (x h , yh, z h ), the geomagnetic direction vectors 
(xh, yH, zh) in the observation coordinate system can be expressed by 
the following equation (1 ) using a product of the Zr rotation matrix and 
the geomagnetic direction vectors in the absolute coordinate system. 
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By transforming the equation (1) to the following equation (2), 
the output values (Xh, yh, Zh) in the directions of the axes with respect to 
the azimuth 0 in the horizontal plane can be converted to an equation 
15 using the geomagnetic direction vectors (x Hl yH, z H ) in the observation 
coordinate system. In the equation (2), the reason that the sign a is 
reversed is because the output value of a tilt angle and the direction of 
rotation are reversed to each other since the counterclockwise rotation 
matrix is set as a reference. 
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r x H cosp-z H sinp 

- x H sinotsinp + y H cosa - z H sinacosp 
x H cosasinp + y H sina + z H cosacosp 



(2) 



From the equation (2), it is possible to obtain the output values 
(x h , yh, Zh) in the directions of the axes indicated when the observation 
coordinate system is converted to the horizontal direction. If the 
output values in the horizontal direction are obtained, the azimuth 9 can 
be obtained from conditional branching according to the following 
equation (3) and sings x h and y h . 



10 0 = arctan 



V X h J 



... (3) 



Japanese Patent No. 3008813 (see page 10, Fig. 5) discloses a 
directional measuring device that calculates a true direction by 
correcting a declination of a magnetic direction. Generally, there is a 

15 slight difference between the true north, which is the north on the map, 
and the magnetic north, which is the direction towards which the needle 
of a magnetic compass points. Because of the geographical location 
of Japan, in Japan, the needle of the magnetic compass always points a 
little westward with respect to the true north. The directional 

20 measuring device disclosed employs a method to correct the magnetic 
direction based on the difference between the direction towards which 
the needle of the magnetic compass points and the true north. 
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In the conventional technology, however, when the body is in 
tilted posture, the azimuth of the body can not be obtained precisely, 
and, the ambiguity in the calculation of the azimuth increases as the tilt 
becomes larger. Such problem arises because of the fact that, when 
5 there is a tilt, the rotational transformation of the x-axis and the y-axis 
does not yield proper results. In other words, when there is a tilt, the 
reverse rotation of the x-axis and the y-axis around the X-axis by the 
roll angle and the reverse rotation of the x-axis and the y-axis around 
the Y-axis by the pitch angle do not yield proper result. The reason is 

10 that the tilt angles (pitch angle and roll angle), which are angles 

between the x-axis or the y-axis and the horizontal plane, cannot be 
used for the rotational transformation as they are. 

When the y-axis is reversely rotated the roll angle around the 
X-axis to make it horizontal, the y-axis is shifted to the horizontal plane, 

15 but the x-axis is also shifted following the shift of the y-axis. 

Consequently, the tilt angle between the x-axis and the horizontal plane 
does not match the pitch angle, that is, a deviation occurs. Therefore, 
even if the x-axis is reversely rotated the pitch angle around the Y-axis, 
the x-axis cannot be shifted to the horizontal plane. The y-axis having 

20 already shifted to the horizontal plane also shifts from the horizontal 
plane through the rotation around the X-axis to cause the y-axis to 
deviate from the horizontal plane. Thus, in the conventional 
technology, the geomagnetic vectors are not returned to the horizontal 
plane depending on the tilt angles, resulting in erroneous calculation of 

25 the azimuth including the error accordingly. 



In the conventional technology, rotation by the angle 9 around 
the Z-axis is performed before rotations round the X-axis and the 
Y-axis; therefore, the azimuth of the observation axis (x-axis) in the 
observation coordinate system sometimes deviates from when the 
5 x-axis is made to rotate in the horizontal plane. If the azimuth deviates 
in this manner, the geomagnetic vector does not match the horizontal 
plane depending on the roll angle ocg and the pitch angle pg, resulting in 
an erroneous azimuth. 

On the other hand, it is possible to calculate an azimuth by 
10 rotating the tilt angle around the x-axis, the y-axis, and the z-axis 
forming the observation coordinate system. However, the x-axis, 
y-axis, and z-axis are difficult to be calculated because the factors 
involved in the rotational transformation become complex, and the 
azimuth is difficult to be calculated. 

15 

SUMMARY OF THE INVENTION 

It is an object of the present invention to solve at least the 
problems in the conventional technology. 

A directional measuring device according to an aspect of the 
20 present invention measures a direction of a body of the directional 
measuring device in a three-dimensional space including an X-axis 
indicating magnetic north on a horizontal plane, a Y-axis orthogonal to 
the X-axis in the horizontal plane, and a Z-axis orthogonal to the 
horizontal plane, assuming that the body points towards an x-axis. 
25 The directional measuring device includes a tilt angle detector that 
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detects an x-axis tilt angle that is an angle between the x-axis and the 
horizontal plane and a y-axis tilt angle that is an angle between a y-axis, 
which is orthogonal to the x-axis, and the horizontal plane; a converter 
that rotates, based on the x-axis tilt angle and the y-axis tilt angle, the 
5 x-axis and the y-axis to obtain a rotated-x-axis and a rotated-y-axis that 
are in the horizontal plane; a primary azimuth calculator that calculates 
a primary azimuth that is an angle between the X-axis and the 
rotated-x-axis; and an azimuth error angle extracting unit that extracts, 
based on the x-axis tilt angle, the y-axis tilt angle, and the primary 

10 azimuth, an azimuth error angle included in the primary azimuth due to 
rotation by the converter. 

A directional measuring method according to another aspect of 
the present invention is a method of measuring a direction of a body of 
the directional measuring device in a three-dimensional space including 

15 an X-axis indicating magnetic north on a horizontal plane, a Y-axis 

orthogonal to the X-axis in the horizontal plane, and a Z-axis orthogonal 
to the horizontal plane, assuming that the body points towards an x-axis. 
The method includes detecting an x-axis tilt angle that is an angle 
between the x-axis and the horizontal plane and a y-axis tilt angle that 

20 is an angle between a y-axis, which is orthogonal to the x-axis, and the 
horizontal plane; rotating, based on the x-axis tilt angle and the y-axis 
tilt angle, the x-axis and the y-axis to obtain a rotated-x-axis and a 
rotated-y-axis that are in the horizontal plane; calculating a primary 
azimuth that is an angle between the X-axis and the rotated-x-axis; and 

25 extracting, based on the x-axis tilt angle, the y-axis tilt angle, and the 



primary azimuth, an azimuth error angle included in the primary azimuth 
due to rotation by the converter. 

The computer program according to still another aspect of the 
present invention realizes the method according to the present 
5 invention on a computer. 

The other objects, features, and advantages of the present 
invention are specifically set forth in or will become apparent from the 
following detailed description of the invention when read in conjunction 
with the accompanying drawings. 

10 

BRIEF DESCRIPTION OF THE DRAWINGS 

Fig. 1 is a block diagram of a hardware configuration of a 
directional measuring device according to an embodiment of the 
present invention; 

15 Fig. 2 is a diagram of an absolute coordinate system in which 

the directional measuring device is disposed; 

Fig. 3 is a block diagram of a functional configuration of the 
directional measuring device; 

Fig. 4 is a diagram to explain contents stored in an azimuth error 
20 angle parameter storage unit; 

Fig. 5 is a diagram to explain a relation among a primary 
azimuth, an azimuth error angle, a secondary azimuth, an X-axis, an 
x-axis, and the direction of the true north; 

Fig. 6 is a graph of a principle for calculation of the secondary 
25 azimuth according to the embodiment (part 1); 



Fig. 7 is a graph of a principle for calculation of the secondary 
azimuth according to the embodiment (part 2); 

Fig. 8 is a flowchart of a process procedure for calculating a 
directional (hereinafter, "directional calculation procedure") (part 1); 
5 Fig. 9 is a flowchart of a process procedure for calculating a 

directional (hereinafter, "directional calculation procedure") (part 2); and 

Fig. 10 is a flowchart of the process procedure based on the 
conventional technology. 

10 DETAILED DESCRIPTION 

Exemplary embodiments of a method and a device for 
measuring a directional and a computer program according to the 
present invention are explained in detail below with reference to the 
accompanying drawings. In the embodiments, a coordinate system 

15 formed with an X (alphabetic capital letter) axis that points towards the 
magnetic north on a horizontal plane, a Y (alphabetic capital letter) axis 
that is orthogonal to the X-axis and is in the horizontal plane, and a Z 
(alphabetic capital letter) axis that is orthogonal to the horizontal plane, 
is referred to as an absolute coordinate system. Further, a direction 

20 towards which the body of the directional measuring device points is 
referred to as an x (alphabetic small letter) axis, an axis that is 
orthogonal to the x-axis is referred to as a y (alphabetic small letter) 
axis, and an axis that is orthogonal to both the x-axis and the y-axis is 
referred to as a z (alphabetic small letter) axis. The x-axis 

25 corresponds to the X-axis, the y-axis to the Y-axis, and the z-axis to the 



Z-axis. 

Fig. 1 is a block diagram of a hardware configuration of a 
directional measuring device according to an embodiment of the 
present invention. A directional measuring device 100 includes a 
5 central processing unit (CPU) 101, a read only memory (ROM) 102, a 
random access memory (RAM) 103, a hard disk drive (HDD) 104, a 
hard disk (HD) 105, a display 106, an interface (l/F) 107, an input key 
108, and an analog-to-digital (A/D) converter 109. The directional 
measuring device 100 also includes an x-axis magnetic sensor 110, a 
10 y-axis magnetic sensor 111 , a z-axis magnetic sensor 112, a global 
positioning system (GPS) receiver 113, an analog-to-digital (A/D) 
converter 114, an x-axis tilt sensor 115, a y-axis tilt sensor 116, and a 
z-axis tilt sensor 117. The components communicate with one another 
through a bus 118. 

15 The CPU 101 controls the whole of the directional measuring 

device 100. The ROM 102 stores programs such as a boot program. 
The RAM 103 is used as a work area of the CPU 101. The HDD 104 
controls read/write of data from/to the HD 105 under the control of the 
CPU 101. The HD 105 stores data. 

20 The display 106 displays a cursor, icons, or tool boxes, and data 

such as documents, images, and functional information. The display 
106 may be a cathode ray tube (CRT), a thin film transistor (TFT) liquid 
crystal display, or a plasma display. 

The l/F 107 is connected to a network such as the Internet 

25 through a communication line. The directional measuring device 100 



is connected, via the l/F 107, to another devices that are connected to 
the network. The l/F 107 interfaces between the network and the 
components, and controls input/output of data from/to an external 
device. The l/F 107 may be a modem or a local area network (LAN) 
5 adaptor. The input unit 108 includes keys for inputting characters, 

numbers, and instructions, and data entry is executed through the input 
unit 108. The input unit 108 may be a touch-panel type input pad or a 
ten-digit keypad. 

The A/D converter 109 converts outputs of the x-axis magnetic 

10 sensor 110, the y-axis magnetic sensor 111, and the z-axis magnetic 
sensor 112 to digital signals. The x-axis magnetic sensor 110 is 
disposed on the x-axis and detects magnetism of the Earth in the x-axis 
direction. The magnetism here means the magnetic flux, the flux 
density, or the magnetic field. Likewise, the y-axis magnetic sensor 

15 111 is disposed on the y-axis and detects magnetism in the y-axis 

direction and the z-axis magnetic sensor 112 is disposed on the z-axis 
and detects magnetism in the z-axis direction. The x-axis magnetic 
sensor 110, the y-axis magnetic sensor 111, and the z-axis magnetic 
sensor 112 output the detected results in the form of electrical signals 

20 to the A/D converter 109. 

The GPS receiver 113 receives radio waves from GPS satellites. 
The geographical position of the GPS receiver 113 with respect to each 
GPS satellite is calculated from the data in the radio waves received 
from a corresponding one of the GPS satellites. This determination is 

25 possible in any locations on Earth. The determination is performed 



using Link 1 (L1 ) radio waves with a carrier wave of 1 575.42 megahertz 
(MHz) and including a course acquisition (C/A) code and a navigation 
message. The C/A code has a bit rate of 1.023 mega-bits-per-second 
(Mbps) and a code length of 1023 bits=1 milliseconds (ms). The 
5 navigation message has a bit rate of 50 bits-per-second (bps), 

sub-frames of a code length 300 bits=6 seconds (s), and main frames of 
code length 1500 bits=30 s. Five sub-frames form one main frame and 
25 main frames form one master frame. In other words, the GPS 
receiver 113 receives radio waves from the GPS satellites to output 

10 GPS positioning data. 

The A/D converter 114 converts outputs of the x-axis tilt sensor 
115, the y-axis tilt sensor 116, and the z-axis tilt sensor 117 to digital 
signals. Each of the x-axis tilt sensor 115, the y-axis tilt sensor 116, 
and the z-axis tilt sensor 117 detects a tilt amount of each axis, and 

15 includes an acceleration sensor. Output of biaxial and triaxial 

acceleration sensor has low sensitivity to another axis, and therefore, it 
is possible to obtain an angle between the horizontal plane and each 
axis. The x-axis tilt sensor 115 is disposed on the x-axis and outputs 
an amount of tilt of the x-axis direction with respect to the horizontal 

20 plane. The y-axis tilt sensor 116 is disposed on the y-axis and outputs 
an amount of tilt of the y-axis direction with respect to the horizontal 
plane. The z-axis tilt sensor 117 is disposed on the z-axis and outputs 
an amount of tilt of the z-axis direction with respect to the horizontal 
plane. 

25 Fig. 2 is a diagram of an absolute coordinate system in which 



the directional measuring device 100 is disposed. A three-dimensional 
space (sphere) 200 formed with the X-axis, the Y-axis, and the Z-axis 
constitutes the absolute coordinate system. The body 120 of the 
directional measuring device 100 is positioned at the origin 0. A 
5 direction that is parallel to the long side of the body 120 corresponds to 
the x-axis. An angle between the x-axis, when it is projected on a 
horizontal plane 210, and the X-axis is an azimuth 0. Further, an angle 
(x-axis tilt angle) between the horizontal plane 210 and the x-axis is 
referred to as pitch angle pg, and is an angle when the body 120 is 
10 rotated around the Y-axis to be shifted to the horizontal plane 210. 

Furthermore, an angle (y-axis tilt angle) between the horizontal plane 
210 and the y-axis is referred to as roll angle ag, and is an angle when 
the body 120 is rotated around the X-axis to be shifted to the horizontal 
plane 210. 

15 A vector 201 represents a geomagnetic vector in the x-axis 

direction detected by the x-axis magnetic sensor 110, a vector 202 
represents a geomagnetic vector in the y-axis direction detected by the 
y-axis magnetic sensor 111, and a vector 203 represents a geomagnetic 
vector in the z-axis direction detected by the z-axis magnetic sensor 

20 112. The length of the vectors 201 to 203 represents a geomagnetic 
force in the respective directions. 

A vector 204 is obtained by vector addition of the vectors 201 to 
203. An angle between the vector 204 and the horizontal plane 210 is 
a dip I at the present position of the body 120. Therefore, coordinates 

25 of the vector 204 in the absolute coordinate system can be obtained 

15 



from: 

(X, Y, Z)=(Sh • cosl, 0, Sh ■ sinl), 
where Sh is an output value indicating the magnitude of the 
geomagnetic vector (total geomagnetic force F). A relation between 
each of the vectors 201 to 204 and each of the relative geomagnetic 
forces is described below: 



|s h | = V*H 2 +y H 2 +ZH 2 - (4) 



X 



-'(5) 



yH=T^r ..-(6) 



ZH=ifr .-(7) 

where 

|S h | : OUTPUT VALUE OF MAGNETIC SENSOR 

CORRESPONDING TO SYNTHESIZED GEOMAGNETIC FORCE F 
x' H : VALUE OBTAINED BY NORMALIZING OUTPUT VALUE OF 

x-AXIS MAGNETIC SENSOR BY WHOLE OUTPUT VALUES 
x H : OUTPUT VALUE OF x - AXIS MAGNETIC SENSOR 
y' H : VALUE OBTAINED BY NORMALIZING OUTPUT VALUE OF 

y - AXIS MAGNETIC SENSOR BY WHOLE OUTPUT VALUES 
y H : OUTPUT VALUE OF y - AXIS MAGNETIC SENSOR 
z' H : VALUE OBTAINED BY NORMALIZING OUTPUT VALUE OF 

z - AXIS MAGNETIC SENSOR BY WHOLE OUTPUT VALUES 
z H : OUTPUT VALUE OF z - AXIS MAGNETIC SENSOR 



The pitch angle pg (x-axis tilt angle) and the roll angle ag (y-axis 
tilt angle) are detected by the x-axis tilt sensor 115 and the y-axis tilt 
sensor 116. A relation between the vectors detected by the x-axis tilt 
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sensor 115, the y-axis tilt sensor 116, and the z-axis tilt sensor 117 and 
their relevant tilt amounts is described below: 



a g = sin 



• •• (8) 



g 




(9) 



... (10) 



where 



x g : OUTPUT VALUE OF x - AXIS ACCELERAT ION SENSOR 
y g : OUTPUT VALUE OF y - AXIS ACCELERATION SENSOR 
z g : OUTPUT VALUE OF z- AXIS ACCELERATION SENSOR 
W g : TOTAL VALUE OF OUTPUTS OF ACCELERATION SENSORS 
CORRESPONDING TO GRAVITY AC CELERATION 

Fig. 3 is a block diagram of a functional configuration of the 
directional measuring device 100. The directional measuring device 
100 includes a geomagnetic force detector 301, a tilt angle detector 302, 
and an azimuth calculator 303. 

The geomagnetic force detector 301 includes an x-axis direction 
geomagnetic force detector 311 (hereinafter, "x-axis geomagnetic force 
detector 311"), a y-axis direction geomagnetic force detector 312 
(hereinafter, "y-axis geomagnetic force detector 312"), a z-axis direction 
geomagnetic force detector 313 (hereinafter, "z-axis geomagnetic force 
detector 313"), a total geomagnetic force input unit 314, and a 
geomagnetic force calculator 315. 

The x-axis geomagnetic force detector 311 detects a 
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geomagnetic force in the x-axis direction. More specifically, the x-axis 
geomagnetic force detector 311 detects the geomagnetic force in the 
x-axis direction from the output of the x-axis magnetic sensor 110, and 
normalizes the geomagnetic force detected by an output value Sh of the 
5 total geomagnetic force F. 

The y-axis geomagnetic force detector 312 detects a 
geomagnetic force in the y-axis direction. More specifically, the y-axis 
geomagnetic force detector 312 detects the geomagnetic force in the 
y-axis direction from the output of the y-axis magnetic sensor 111, and 

10 normalizes the geomagnetic force detected by an output value Sh of the 
total geomagnetic force F. 

The z-axis geomagnetic force detector 313 detects a 
geomagnetic force in the z-axis direction. More specifically, the z-axis 
geomagnetic force detector 313 detects the geomagnetic force in the 

15 z-axis direction from the output of the z-axis magnetic sensor 112, and 
normalizes the geomagnetic force detected by an output value Sh of the 
total geomagnetic force F. 

The total geomagnetic force input unit 314 inputs a total 
geomagnetic force at a present position of the body 120. More 

20 specifically, the information for the present position of the body 120 
obtained from the GPS receiver 113 is transmitted to a server (not 
shown). The server identifies a latitude and a longitude of the present 
position of the body 120 from the received present position information 
and transmits the value Sh of the total geomagnetic force F 

25 corresponding to the latitude and the longitude to the directional 



measuring device 100. The directional measuring device 100 receives 
the value Sh of the total geomagnetic force F. 

The geomagnetic force calculator 315 calculates a geomagnetic 
force in a direction of an axis (third axis) other than a first axis and a 
5 second axis based on the total geomagnetic force at the present 
position input by the total geomagnetic force input unit 314 and 
geomagnetic force detectors in two axes (the first axis and the second 
axis) of the geomagnetic force detector 301 . The geomagnetic force 
detectors in two axes are selected from the x-axis geomagnetic force 

10 detector 311, the y-axis geomagnetic force detector 312, and the z-axis 
geomagnetic force detector 31 3. 

More specifically, if the directional measuring device 100 
includes only the x-axis magnetic sensor 110 and the y-axis magnetic 
sensor 111, a geomagnetic force in the z-axis direction can be 

15 calculated using the equation (4). 

The tilt angle detector 302 includes an x-axis tilt angle detector 
321 and a y-axis tilt angle detector 322. The x-axis tilt angle detector 
321 detects the x-axis tilt angle, which is the pitch angle pg, between 
the horizontal plane 210 and the x-axis from the output of the x-axis tilt 

20 sensor 115. The y-axis tilt angle detector 322 detects the y-axis tilt 
angle, which is the roll angle ag, between the horizontal plane 210 and 
the y-axis from the output of the y-axis tilt sensor 116. 

The azimuth calculator 303 includes a converter 331, a primary 
azimuth calculator 332, an azimuth error angle extracting unit 333, a 

25 declination input unit 336, and a secondary azimuth calculator 337. 



The converter 331 converts the x-axis and the y-axis so as to be in the 
horizontal plane using the x-axis tilt angle and the y-axis tilt angle 
detected by the tilt angle detector 302. More specifically, coordinate 
transformation is performed twice to the coordinates of the 
5 three-dimensional magnetic vectors 201 to 203 (see Fig. 2) indicating 
geomagnetic forces detected by the geomagnetic force detector 301, 
using the x-axis tilt angle and the y-axis tilt angle detected by the tilt 
angle detector 302 to calculate a magnetic vector of a horizontal 
magnetic field component. 

10 The conversion process by the converter 331 is explained in 

further detail below with reference to specific equations. An 
observation coordinate system, which corresponds to the x-axis, the 
y-axis, and the z-axis, is a coordinate system obtained by rotating an 
absolute coordinate system, which corresponds to the X-axis, the Y-axis, 

15 and the Z-axis, around the Z-axis by angle 9 (azimuth) counterclockwise, 
around the Y-axis by angle p counterclockwise, and around X-axis by 
angle a counterclockwise. The x-axis is an observation axis. A 
rotation matrix corresponding to a rotation around the Z-axis is 
assumed to be Zr, a rotation matrix corresponding to a rotation around 

20 the Y-axis is assumed to be Yr, and a rotation matrix corresponding to a 
rotation around the X-axis is assumed to be Xr. 

Geomagnetic direction vectors (x Hl yi-i, z H ) in the observation 
coordinate system can be expressed in a form obtained by converting 
geomagnetic direction vectors (X, Y, Z) in the absolute coordinate 

25 system using inverse matrixes of the rotation matrixes Zr, Yr, and Xr. 



If output values of the azimuth 0 in the horizontal plane in the directions 
of the axes are taken as (x hl yh, Zh), the geomagnetic direction vectors 
(xh, Yh, Zh) in the observation coordinate system can be expressed by 
the following equation (11) using a product of the Zr rotation matrix and 
5 the geomagnetic direction vectors in the absolute coordinate system. 
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By transforming the equation (11) to the following equation (12), 
10 the output values (x h , yh, z h ) in the directions of the axes with respect to 
the azimuth 0 in the horizontal plane can be converted to an equation 
using the geomagnetic direction vectors (x Hf yH, z H ) in the observation 
coordinate system. In the equation (12), the reason that the sign a is 
reversed in the equation (12) is because the output value of a tilt angle 
15 and the direction of rotation are reversed to each other since the 
counterclockwise rotation matrix is set as a reference. 
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The primary azimuth calculator 332 calculates a primary azimuth 
01 that is an angle between the X-axis that indicates the magnetic north 
and the x-axis converted by the converter 331. Explanation is given 
using specific equations. From the equation (12), it is possible to 
obtain the output values (x h , yh, Zh) in the directions of the axes when 
the observation coordinate system is converted to that in the horizontal 
direction. If the output values in the horizontal direction are obtained, 
the primary azimuth 01 can be obtained from conditional branching 
according to the following equation (13) and the sings x h and y h . 



The azimuth error angle extracting unit 333 extracts an azimuth 
error angle A0 included in the primary azimuth 01 by the conversion 
performed by the converter 331 based on the x-axis tilt angle (pitch 
angle pg) and the y-axis tilt angle (roll angle ag) detected by the tilt 
angle detector 302 and the primary azimuth 01 calculated by the 
primary azimuth calculator 332. More specifically, the azimuth error 
angle extracting unit 333 includes an azimuth error angle parameter 
storage unit 334 and an azimuth error angle calculator 335. 

The azimuth error angle parameter storage unit 334 stores 
parameters required for calculation of the azimuth error angle A0. The 
contents stored in the azimuth error angle parameter storage unit 334 




... (13) 
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are explained below specifically. Fig. 4 is a diagram to explain the 
contents stored in the azimuth error angle parameter storage unit 334. 
The azimuth error angle parameter storage unit 334 stores an azimuth 
error: offset 5, an amplitude width WG, and a phase difference oo that 
5 are azimuth error angle parameters, in each combination of the roll 
angle ag and the pitch angle pg. The azimuth error: offset 5 
mentioned here is a predetermined value that is set based on directions 
and magnitudes of the tilt angles (roll angle ag and pitch angle pg) 
detected by the tilt angle detector 302. 

10 The amplitude width W9 represents an amplitude of a sine curve 

that is a variation of the azimuth error angle AG. The phase difference 
co represents positive and negative characteristics of the sine curve that 
are variations of the azimuth error angle AG. The sine curve is 
explained later. The azimuth error angle parameter storage unit 334 

15 realizes its functions by, for example, the ROM 102, the RAM 103, and 
the HD 105. 

The azimuth error angle calculator 335 outputs an azimuth error 
angle AG included in the primary azimuth G1 by the conversion 
performed by the converter 331 based on the tilt angles (roll angle ag 

20 and pitch angle pg) detected by the tilt angle detector 302 and the 
primary azimuth 61 calculated by the primary azimuth calculator 332. 
More specifically, the azimuth error angle calculator 335 extracts the 
azimuth error: offset 5, the amplitude width WG, and the phase 
difference co from the azimuth error angle parameter storage unit 334. 

25 The azimuth error angle calculator 335 calculates an azimuth error 



angle A0 using the azimuth error angle parameters extracted. 
Explanation is given more specifically using equations. The azimuth 
error angle calculator 335 calculates an azimuth error angle A0 by 
substituting the azimuth error angle parameters and the primary 
5 azimuth 01 in the sine curve that becomes the valuations of the azimuth 
error angle A0 of the following equation (14). 

A0=5+coxW0xsin01 ... (14) 

Note that the phase difference co takes "+1" in the positive case 
and in the negative case. 

10 The azimuth error: offset 5 in the right side of the equation (14) 

is a first error angle with a predetermined amount based on directions 
and magnitudes of the tilt angles (roll angle ag and pitch angle pg) 
detected by the tilt angle detector 302, and coxW0xsin01 is a sine curve 
that represents variation characteristics of the azimuth error angle AG. 

15 The value of the sine curve becomes a second error angle that 

represents variations by which the azimuth error: offset 5 that is the first 
error angle varies. 

The declination input unit 336 inputs a declination D that is an 
angle between the magnetic north at the present position of the body 

20 and the true north. For the declination at the present position thereof 
in Japan, the results of measurement of magnetism are disclosed as a 
table by the Geographical Survey Institute, and therefore, the 
declination D at any region is obtained by the table. More specifically, 
the information for the present position of the body 120 obtained from 

25 the GPS receiver 113 is transmitted to a server (not shown). The 



server identifies a latitude and a longitude of the present position of the 
body 120 from the present position information received and transmits 
declination data corresponding to the latitude and the longitude to the 
directional measuring device 100. The directional measuring device 
5 100 receives the declination data. The declination input unit 336 can 
obtain the declination by using a declination calculating method of 
approximating it by a quadratic equation. More specifically, the 
declination input unit 336 can input declination D by calculating it using 
the following equation (15) to equation (17). 

10 

D 2000.0 = 7°37.142' + 21 .622'A<|> - 7.672'AX + 0.442'A<|> 2 - 0.32'A(|>A*, + 0.675'AA- 2 

...(15) 

Acp = (LATITUDE cp AT MEASURED POSITION)- 37 ... (16) 
AA = (LONGITUDE A AT MEASURED POSITION)- 138 ... (17) 

15 

The secondary azimuth calculator 337 calculates a secondary 
azimuth 02 that represents a direction of the body 120 based on the 
primary azimuth 01 calculated by the primary azimuth calculator 332 
and the azimuth error angle A0 calculated by the azimuth error angle 
20 calculator 335. More specifically, the secondary azimuth calculator 
337 calculates an azimuth 02a based on the magnetic north as a 
reference using the following equation (18). 

02a=01-A0 ... (18) 

The secondary azimuth calculator 337 further calculates an 
25 azimuth 02b based on the true north as a reference using the following 

25 



equation (19), based on the declination D input by the declination input 
unit 336. 

92b=91-Ae-D ... (19) 

Shown in Fig. 5 is a relation among the primary azimuth 91, the 
5 azimuth error angle AG, the secondary azimuths 02a and 02b, the 

X-axis that is the magnetic north, the x-axis that is a direction towards 
which the body 120 points, and the direction of the true north. The 
geomagnetic force detector 301 , the tilt angle detector 302, and the 
azimuth calculator 303 perform their functions when the CPU 101 
10 executes programs stored in the ROM 102, the RAM 103, and the HD 
105 as shown in Fig. 1 . 

The calculation principle of a secondary azimuth according to 
the embodiment of the present invention is explained below. Fig. 6 
and Fig. 7 are graphs that represent the calculation principle of the 
15 secondary azimuth, and represent a relation between the primary 

azimuth 01 and the azimuth error angle A0. In Fig. 6 and Fig. 7, the 
horizontal-axis represents the primary azimuth 01, and the vertical-axis 
represents the azimuth error angle A0. 

As shown in Fig. 6, variable functions 601 to 606 that represent 
20 a relation between the primary azimuth 01 and the azimuth error angle 
A0 are plotted in each combination of the roll angle ag and the pitch 
angle pg. The variable functions 601 to 606 plotted represent an error 
amount included in the primary azimuth 01 by the conversion performed 
by the converter 331 when the secondary azimuth that is the true 
25 azimuth is set to azimuth error angle A0=O. 



The variable function 604 as shown in Fig. 6 is explained below 
as an example. The variable function 604 is a characteristic curve 
indicating an azimuth error angle AG when the roll angle ag is 30 
degrees and the pitch angle pg is -30 degrees. It is understood from 
5 this sine curve that the azimuth error: offset 5 is 16.8 degrees, the 
amplitude width W6 is 5.3 degrees, and the phase difference co has a 
negative characteristic. In the phase difference co, the case where the 
variable function 604 follows the sine curve is expressed as a positive 
(+) phase, and the sine curve when the phase leads by 180 degrees is 

10 expressed as a negative (-) phase. 

A method of calculating the secondary azimuth 92 is explained 
below. As shown in Fig. 7, a variable function 701 is a sine curve 
when the roll angle ag is -30 degrees and the pitch angle pg is -30 
degrees. A first error angle 51 that is an azimuth error: offset 5 of the 

15 variable function 701 is canceled by the first term in the right side of the 
equation (14) to be made to a variable function 702. In the variable 
function 702, a second error angle 52 (52=©xW9xsin 91 ) that is 
variations of the first error angle 51 is canceled by the second term in 
the right side of the equation (14) to convert the variable function 702 to 

20 a variable function 703. Since the variable function 703 expresses the 
azimuth error angle A9=0, the azimuth error angle AG has been erased 
from the primary azimuth 91. 

Fig. 8 is a flowchart of a directional calculation procedure (part 
1) according to the embodiment of the present invention. As shown in 

25 the flowchart, geomagnetic forces along the x-axis, the y-axis, and the 



z-axis are detected from outputs of the x-axis, y-axis, and z-axis 
magnetic sensors 110 to 112 (step S801). Further, an x-axis tilt angle 
(pitch angle pg) and a y-axis tilt angle (roll angle ag) are detected from 
outputs of the x-axis and y-axis tilt sensors 115 and 116 (step S802). 
5 Next, by using the equation (12), the x-axis and the y-axis are 

converted so as to be in the horizontal plane based on the geomagnetic 
forces along the x-axis, the y-axis, and the z-axis, and the x-axis tilt 
angle (pitch angle pg) and the y-axis tilt angle (roll angle ag) (step 
S803). By using the equation (13), an angle, i.e., a primary azimuth 91 

10 that is an angle between the x-axis converted and the X-axis that 
indicates the magnetic north is calculated (step S804). 

Next, azimuth error angle parameters (azimuth error: offset 5, 
amplitude width W0, and phase difference ©) of the x-axis tilt angle 
(pitch angle pg) and the y-axis tilt angle (roll angle ag) detected at step 

15 S802 are extracted to calculate an azimuth error angle A0 of the 

primary azimuth calculated at step S804 (step S805). If the declination 
D at the present position of the body has not been input (step S806: 
No), a secondary azimuth 02a based on the magnetic north as a 
reference is calculated (step S807) by using the equation (18). On the 

20 other hand, if the declination D at the present position has been input 
(step S806: Yes), a secondary azimuth based on the true north as a 
reference is calculated (step S808). 

In the embodiment, the azimuth error angle A0 included in the 
primary azimuth 01 by the conversion performed by the converter 331 is 

25 calculated in each combination of the roll angle ag and the pitch angle 



(5g of the body 120, which allows the azimuth error angle A0 to be 0. 
Thus, it is possible to calculate the true azimuth 02 with high precision. 

Fig. 9 is a flowchart of the directional calculation procedure (part 
2) according to the embodiment. The process procedure is used to 
calculate a secondary azimuth 02 by a so-called biaxial magnetic 
sensor. As one example here, the x-axis is set as a first axis, the 
y-axis as a second axis, and the z-axis as a third axis. The magnetic 
sensor is provided on the first and second axes, and no magnetic 
sensor is provided on the third axis. 

As shown in Fig. 9, at first, geomagnetic forces in the directions 
of the first axis and the second axis are detected from outputs of the 
first axis and second axis magnetic sensors (step S901). A total 
geomagnetic force at the present position is input (step S902). The 
total geomagnetic force F in each region in Japan can be approximated 
by the following equation (20) to equation (22). 

F 2 ooo.o = 47505.3881 + 567.453Acp - 294.499A A - 0.225A<p 2 
-2.975AcpAA + 1.291AA 2 

Acp = (LATITUDE cp AT MEASURED POSITION)- 37 ... (21) 

AA = (LONGITUDE A AT MEASUREDPOSITION)-138 ... (22) 

Next, a geomagnetic force in the direction of the third axis is 
calculated (step S903). The geomagnetic force in the third axis 
direction can be calculated at this step by the following equation (23) to 
equation (25). 
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x' = T X * r ...(23) 
S' 



ft = £7 .-(24) 



Zh = Vi-(xh 2 +Vh 2 ) -(25) 



where 



x„ , 9h : VALUES OBTAINED BY NORMALIZING OUTPUT 

VALUES OF x-AXIS AND y - AXIS MAGNETIC SENSORS BY S'h 
x H , y H : OUTPUT VALUES OF x - AXIS AND y - AXIS MAGNETIC SENSORS 

\S' | : OUTPUT VALUE OF MAGNETIC SENSOR CORRESPONDING 

TO TOTAL GEOMAGNETIC FORCE F. 



The calculated geomagnetic force of the third axis is output 
(step S904). The steps thereafter are the same as those in Fig. 8, and 

10 therefore, explanation thereof is omitted. According to this procedure, 
the biaxial magnetic sensor is capable of measuring directions with high 
precision in the same manner as that of the triaxial magnetic sensor. 
Furthermore, it is possible to reduce the number of components, 
minimize, and reduce its weight, thus providing the directional 

15 measuring device 100 at a low cost. 

In the embodiment, the azimuth error angle calculator 335 
calculates and outputs the azimuth error angle AG. However, the 
azimuth error angle parameter storage unit 334 may be configured to 
previously store the azimuth error angle A0 calculated for each roll 

20 angle ocg and pitch angle |3g, and an azimuth error angle A9 
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corresponding to the present roll angle ag and pitch angle (3g of the 
body 120 may be extracted from the azimuth error angle parameter 
storage unit 334. 

In the embodiment, the method of correction that is commonly 
5 used in Japan, i.e., a method that uses the primary azimuth 01, the 
azimuth error angle AG, and the declination D, has been explained, but 
it is not limited to this method. If a latitude <(> and a longitude X of a 
measured position are given in any region all over the world, it is 
possible to obtain declination D and total geomagnetic force F. 

10 Therefore, data for the declination D and the total geomagnetic force F 
are stored in advance as database, which allows acquisition of a 
precise direction in any region all over the world. 

Furthermore, the calculation equation is not limited to that in the 
above embodiment, and therefore, the users can use any of methods as 

15 follows to acquire the calculation equation. The methods include a 
method of directly inputting the declination D by the user to perform 
calculation, and a method of automatically acquiring position 
information through communications, radio waves, or GPS to calculate 
it with a measurement equation. The methods also include a method 

20 of automatically acquiring it through access to a server, on a network, 
including a table in which position information correlates with 
declination D, total geomagnetic force F, and dip. 

Furthermore, in the embodiment, the explanation is given based 
on an integrated circuit (IC) module, but it is not limited to this. 

25 Therefore, the directional measuring device 100 including a display unit 



and a power source and operating as a single unit may be used. 
Alternatively, the directional measuring device 100 may be incorporated 
in any of electronic devices. Further, all the hardware components as 
shown in Fig. 1 are not necessarily integrated into one unit, but, for 
5 example, the measurement may be performed by a CPU or a 

microcomputer in the device including the directional measuring device 
100. 

In the embodiment, data for the declination D and the total 
geomagnetic force F can be acquired from the latitude and the 

10 longitude of the present position of the body. Therefore, the user can 
freely select or combine the data. Even if the user does not select the 
data, initial values of the data can be stored in the directional 
measuring device 100 to measure a direction using them. 

Furthermore, in the embodiment, a total output value Wg has 

15 been calculated with a square root of a squared sum of the output 

values of the acceleration sensors in the respective axes by using the 
triaxial acceleration sensor as the tilt sensors 115 to 117 in the three 
axes. However, since the gravity acceleration g corresponds to the 
total output value Wg, the total output value may be used. In this case, 

20 by calculating the total output value Wg, an acceleration in the 

measurement is obtained. Furthermore, by comparing the acceleration 
with the known gravity acceleration, information as to whether any 
acceleration factor other than the gravity acts is also obtained, and 
therefore, correction may be performed using the information. 

25 Moreover, the tilt sensors 115 to 117 may be configured not with three 
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axes but with two axes. In this case, by inputting the total output value 
Wg corresponding to the gravity acceleration, a tilt angle of the 
respective axes can be calculated. 

It is assumed that the directional measuring device 100 is used 
5 and held by the users in various ways, and it is quite possible that the 
directional measuring device 100, i.e., the magnetic sensors 110 to 112 
may be used even when they are tilted with respect to the horizontal 
plane 210. In such a case also, it is possible to calculate the 
secondary azimuth 02 with high precision even in a state where the 

10 body 120 is tilted. Particularly, the present invention is effective in cell 
phones, portable information terminals such as PDA, and wrist watches. 
Furthermore, the algorism used in the directional measuring device 100 
is simple to make it easy to be incorporated in various devices. 

The direction measuring method according to the embodiment of 

15 the present invention is realized by executing the previously prepared 

program on a computer such as a personal computer and a work station. 
The program is recorded in a computer-readable recording medium 
such as a hard disk, a flexible disk, a compact disk-read only memory 
(CD-ROM), a magneto-optic disk (MO), and a digital versatile disk 

20 (DVD). The program is then executed by being read out from the 

recording medium by the computer. Furthermore, the program may be 
a transmission medium capable of being distributed through a network 
such as the Internet. According to the directional measuring device, 
the directional measuring method, and the directional measuring 

25 program according to the present invention, even if a value of an 



azimuth error angle included in a primary azimuth varies caused by any 
combination of a roll angle and a pitch angle of the body, an azimuth 
error angle corresponding to the roll angle and the pitch angle can be 
extracted at each primary azimuth by converting the x-axis that is a 
direction towards which the body points to an axis in the horizontal 
plane. Thus, a secondary azimuth that is a true azimuth can be 
calculated by the primary azimuth and the azimuth error angle extracted. 
Therefore, it is possible to measure a direction with lesser efforts and 
high precision by performing a simple computation even if the body is in 
a tilted posture. 

Although the invention has been described with respect to a 
specific embodiment for a complete and clear disclosure, the appended 
claims are not to be thus limited but are to be construed as embodying 
all modifications and alternative constructions that may occur to one 
skilled in the art which fairly fall within the basic teaching herein set 
forth. 
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